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Abstract — The  paper  addresses  the  problem  of  steering  a 
fleet  of  wheeled  robots  along  a  set  of  given  spatial  paths,  while 
keeping  a  desired  inter-vehicle  formation  pattern.  This  problem 
arises  for  example  when  multiple  vehicles  are  required  to  scan  a 
given  area  in  cooperation.  In  a  possible  mission  scenario,  one  of 
the  vehicles  acts  as  a  leader  and  follows  a  path  accurately,  while 
the  other  vehicles  follow  paths  that  are  naturally  determined 
by  the  formation  pattern  imposed.  The  solution  adopted  for  co¬ 
ordinated  path  following  builds  on  Lyapunov-based  techniques 
and  addresses  explicitly  the  constraints  imposed  by  the  topology 
of  the  inter-vehicle  communications  network,  which  is  captured 
in  the  framework  of  directed  graph  theory.  With  this  set-up, 
path  following  (in  space)  and  inter-vehicle  coordination  (in 
time)  are  essentially  decoupled.  Path  following  for  each  vehicle 
amounts  to  reducing  a  conveniently  defined  error  variable  to 
zero.  Vehicle  coordination  is  achieved  by  adjusting  the  speed 
of  each  of  the  vehicles  along  its  path,  according  to  information 
on  the  position  of  the  other  vehicles,  as  determined  by  the 
communications  topology  adopted.  Simulations  illustrate  the 
efficacy  of  the  solution  proposed. 

Index  Terms —  Coordinated  Motion  Control,  Nonlinear  Con¬ 
trol,  Path  Following,  Graph  Theory,  Wheeled  Robots. 

I.  Introduction 

In  recent  years,  there  has  been  widespread  interest  in 
the  problem  of  coordinated  motion  control  of  fleet  of  au¬ 
tonomous  vehicles.  Applications  include  aircraft  and  space¬ 
craft  formation  flying  control  (Giuletti  el  al.,  2000),  (Pratcher 
et  al.,  2001),  coordinated  control  of  land  robots  (Ogren  et 
al.,  2002)  and  control  of  multiple  surface  and  underwa¬ 
ter  vehicles  (Lncarnacao  and  Pascoal,  2001),  (Lapierre  et 
al.,  2003a),  (Skjetne  et  al.,  2002). 

At  first  inspection,  the  problem  of  coordinated  motion  con¬ 
trol  seems  to  fall  within  the  domain  of  decentralized  control. 
However,  as  clearly  pointed  out  in  (Fax  and  Murray,  2002), 
(Fax  and  Murray,  2003),  it  possesses  several  unique  aspects 
that  are  at  the  root  of  new  challenges  to  system  designers. 
Among  these,  the  following  are  worth  stressing: 

i)  except  for  some  cases  in  the  area  of  aircraft  control,  the 
motion  of  one  vehicle  does  not  directly  affect  the  motion 
of  the  other  vehicles,  that  is,  the  vehicles  are  dynamically 
decoupled;  the  only  coupling  arises  naturally  out  of  the 
specification  of  the  tasks  that  they  are  required  to  accomplish 
together. 
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ii)  there  are  strong  practical  limitations  to  the  flow  of  in¬ 
formation  among  vehicles,  which  is  severely  restricted  by  the 
nature  of  the  supporting  communications  network.  In  marine 
robotics,  for  example,  underwater  communications  rely  on 
the  propagation  of  acoustic  waves.  This  sets  tight  limits  on 
the  communication  bandwidths  that  are  achievable.  Thus,  as 
a  rule,  possibly  no  vehicle  will  be  able  to  communicate  with 
the  entire  formation  (Fax  and  Murray,  2003).  A  reliable 
vehicle  coordination  scheme  should  also  exhibit  some  form 
of  robustness  against  certain  kinds  of  vehicle  failures  or  loss 
of  inter-vehicle  communications. 

A  rigorous  methodology  to  deal  with  some  of  the  above 
issues  has  emerged  from  the  work  reported  in  (Fax  and 
Murray,  2002),  (Fax  and  Murray,  2003),  which  addresses 
explicitly  the  topics  of  information  flow  and  cooperation  con¬ 
trol  of  vehicle  formations  simultaneously.  The  methodology 
proposed  builds  on  an  elegant  framework  that  involves  the 
concept  of  Graph  Laplacian  (a  matrix  representation  of  the 
graph  associated  with  a  given  communication  network).  In 
particular,  the  results  in  (Fax  and  Murray,  2003)  show  clearly 
how  the  Graph  Laplacian  associated  with  a  given  inter¬ 
vehicle  communication  network  plays  a  key  role  in  assessing 
stability  of  the  behaviour  of  the  vehicles  in  a  formation.  It 
is  however  important  to  point  out  in  that  work  that:  i)  the 
dynamics  of  the  vehicles  are  assumed  to  be  linear,  time- 
invariant,  and  ii)  the  information  exchanged  among  vehicles 
is  restricted  to  linear  combinations  of  the  vehicles’  state 
variables. 

Inspired  by  the  progress  in  the  field,  this  paper  tackles  a 
problem  in  coordinated  vehicle  control  that  departs  slightly 
from  mainstream  work  reported  in  the  literature.  Specifically, 
we  consider  the  problem  of  coordinated  path  following 
where  multiple  vehicles  are  required  to  follow  pre-specified 
spatial  paths  while  keeping  a  desired  inter-vehicle  formation 
pattern  in  time.  This  mission  scenario  occurs  naturally  in 
underwater  robotics  (Pascoal  et  al,,  2000).  Namely,  in 
the  operation  of  multiple  autonomous  underwater  vehicles 
for  fast  acoustic  coverage  of  the  seabed.  In  this  important 
case,  two  or  more  vehicles  are  required  to  fly  above  the 
seabed  at  the  same  or  different  depths,  along  geometrically 
similar  spatial  paths,  and  map  the  seabed  using  copies  of 
the  same  suite  of  acoustic  sensors.  By  requesting  that  the 
vehicles  traverse  identical  paths  so  as  to  make  the  acoustic 
beam  coverage  overlap  along  the  seabed,  large  areas  can  be 
covered  in  a  short  time.  This  imposes  constraints  on  the  inter- 
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vehicle  formation  pattern.  Similar  scenarios  can  of  course  be 
envisioned  for  land  and  air  vehicles. 

To  the  best  of  our  knowledge,  previous  work  on  coordi¬ 
nated  path  following  control  has  essentially  been  restricted 
to  the  area  of  marine  robotics.  See  for  example  (Lapierre  et 
al.,  2003a),  (Lapierre  et  al,  2003b),  (Skjetne  et  al.,  2003) 
and  the  references  therein.  However,  the  solutions  devel¬ 
oped  so  far  for  underactuated  vehicles  are  restricted  to 
two  vehicles  in  a  leader-follower  type  of  formation  and 
lead  to  complex  control  laws.  There  is  therefore  a  need  to 
re-examine  this  problem  to  try  and  arrive  at  efficient  and 
practical  solutions. 

A  possible  strategy  is  to  consider  similar  problems  for 
wheeled  robots  in  the  hope  that  the  solutions  derived  for 
this  simpler  case  may  shed  some  light  into  the  problem  of 
coordinated  path  following  for  the  more  complex  case  of 
air  and  marine  robots.  Preliminary  steps  in  this  direction 
were  taken  in  (Ghabcheloo  et  al.,  2004a),  where  the  problem 
of  coordinated  path  following  of  multiple  wheeled  robots 
was  solved  by  resorting  to  linearization  and  gain  scheduling 
techniques.  The  solutions  obtained  are  conceptually  simple 
and  embody  in  themselves  a  straightforward  mechanism  that 
allows  for  the  decoupling  of  path  following  (in  space)  and 
vehicle  synchronization  (in  time).  The  price  paid  for  the 
simplicity  of  the  solutions  is  the  lack  of  global  results, 
that  is,  attractivity  to  so-called  trimming  paths  and  to  a 
desired  formation  pattern  can  only  be  guaranteed  locally, 
when  the  initial  vehicle  formation  is  sufficiently  close  to 
the  desired  one.  The  present  paper  overcomes  this  limitation 
and  yields  global  results  that  allow  for  the  consideration 
of  arbitrary  formation  patterns  and  initial  conditions.  The 
solution  adopted  for  coordinated  path  following  builds  on 
Lyapunov  based  techniques  and  addresses  explicitly  the  con¬ 
straints  imposed  by  the  topology  of  the  inter-vehicle  commu¬ 
nications  network.  The  latter  is  captured  in  the  framework  of 
directed  graph  theory,  which  allows  for  the  consideration  of 
communication  topologies  that  contain  unidirectional  links. 
This  is  in  striking  contrast  with  some  topologies  studied 
in  the  literature  where  all  links  are  bi-directional  (that  is, 
if  vehicle  i  ’’talks”  to  vehicle  j,  then  j  ’’talks”  to  i  as 
well).  With  the  theoretical  set-up  adopted,  path  following 
(in  space)  and  inter-vehicle  coordination  (in  time)  are  essen¬ 
tially  decoupled.  Path  following  for  each  vehicle  amounts 
to  reducing  a  conveniently  defined  error  variable  to  zero. 
Vehicle  coordination  is  achieved  by  adjusting  the  speed  of 
each  of  the  vehicles  along  its  path,  according  to  information 
on  the  position  of  the  other  vehicles,  as  determined  by  the 
communications  topology  adopted.  No  other  kinematic  or 
dynamic  information  is  exchanged  among  the  robots.  The 
coordination  strategy  is  simple  and  holds  great  potential  to 
be  extended  and  applied  to  the  case  of  air  and  marine  robots. 

The  paper  is  organized  as  follows.  Section  II  introduces 
the  basic  notation  required,  describes  the  simplified  model 
of  a  wheeled  robot,  and  offers  a  new  solution  to  the  problem 
of  path  following  for  a  single  vehicle.  The  main  contribution 
of  the  paper  is  summarized  in  Section  III,  where  a  nonlinear 
control  strategy  for  multiple  vehicle  cooperation  is  proposed. 
Section  IV  describes  the  results  of  simulations.  Finally,  Sec¬ 
tion  V  contains  the  main  conclusions  and  presents  problems 
that  warrant  further  research. 


II.  Path  Following 

This  section  describes  a  new  solution  to  the  problem  of 
path  following  control  for  a  single  wheeled  robot.  Due  to 
space  limitations,  only  the  basic  concepts  and  results  will  be 
presented.  Complete  details  can  be  found  in  (Ghabcheloo  et 
al,  2004c)  and  (Kaminer  et  al,  2005). 

Consider  a  wheeled  robot  of  the  unicycle  type  depicted 
in  Fig.  1,  together  a  spatial  path  F  to  be  followed.  Two 
motorized  rear  wheels  generate  a  control  force  and  a  control 
torque  applied  to  the  vehicle.  The  problem  of  path  following 
can  be  briefly  stated  as  follows: 

Given  a  spatial  path  T,  develop  a  feedback  control  law 
for  the  force  and  torque  acting  on  a  wheeled  robot  so  that 
its  center  of  mass  converges  asymptotically  to  the  path  while 
its  total  speed  tracks  a  desired  temporal  profile. 

An  elegant  solution  to  this  problem  was  first  advanced  at 
a  kinematic  level  in  (Micaelli  et  al.,  1993),  from  which  the 
following  intuitive  explanation  is  obtained:  a  path  following 
controller  should  ’’look”  at  i)  the  distance  from  the  vehicle 
to  the  path  and  ii)  the  angle  between  the  vehicle’s  velocity 
vector  and  the  tangent  to  the  path,  and  reduce  both  to  zero. 
This  suggests  that  the  kinematic  model  of  the  vehicle  be 
derived  with  respect  to  a  Serret-Frenet  frame  {T }  that  moves 
along  the  path,  with  {T }  playing  the  role  of  the  body-axis 
of  a  ’’virtual  target  vehicle”  that  must  be  tracked  by  the  ’’real 
vehicle”.  Using  this  set-up,  the  abovementioned  distance  and 
angle  become  part  of  the  coordinates  of  the  error  space  where 
the  path  following  control  problem  can  be  formulated  and 
solved.  The  set-up  adopted  in  (Micaelli  et  al.,  1993)  was  later 
reformulated  in  (Soeanto  et  al.,  2003),  leading  to  a  feedback 
control  law  that  steers  the  dynamic  model  of  a  wheeled 
robot  with  parameter  uncertainty  along  a  desired  path  and 
yields  global  convergence  results.  This  is  in  contrast  with  the 
results  described  in  (Micaelli  et  al.,  1993),  where  only  local 
convergence  to  the  path  has  been  proven.  The  key  enabling 
idea  involved  in  the  derivation  of  a  globally  convergent  path 
following  control  law  is  to  add  another  degree  of  freedom 
to  the  rate  of  progression  of  a  ’’virtual  target”  to  be  tracked 
along  the  path,  thus  bypassing  the  singularity  problems  that 
arise  in  (Micaelli  et  al.,  1993)  when  the  position  of  the  virtual 
target  is  simply  defined  by  the  projection  of  the  actual  vehicle 
on  that  path.  Formally,  this  is  done  by  making  the  center  of 
the  Serret-Frenet  frame  {T }  that  is  attached  to  the  path  evolve 
according  to  an  extra  ’’virtual”  control  law. 

To  this  effect,  consider  Fig.  1  where  P  is  an  arbitrary  point 
on  the  path  to  be  followed  and  Q  is  the  center  of  the  mass 
of  the  vehicle.  Associated  with  P,  consider  the  Serret-Frenet 
frame  {T}.  The  signed  curvilinear  abscissa  of  P  along  the 
path  is  denoted  by  s.  Let  ( xe,ye )  denote  the  coordinates  of 
Q  in  {T}.  Further,  let  the  rotations  from  {T }  to  {U}  and 
from  {B }  to  {U}  be  denoted  by  the  yaw  angles  fix  and  fi>B, 
respectively.  Define  the  variables  v  and  r  =  fin  as  the  linear 
and  angular  speed  of  the  robot,  respectively,  calculated  in 
{U}  and  expressed  in  {B}.  Simple  calculations  lead  to  the 
kinematics  of  the  robot  in  the  ( xe,ye )  coordinates  as 

{xe  =  {yecc(s)  -  l)s  +  v  cos  f>e 

ye  =  —xecc(s)s  +  v  sin  tpe  (1) 

tpe  =  r-  cc(s)s. 
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Fig.  1.  Frames  and  error  variables 


where  ipe  =  ips  —  ipT  and  cc(s)  is  the  path  curvature  at 
P  determined  by  s,  that  is  ipT  =  cc(s)s.  Notice  how  the 
kinematics  are  driven  by  v,  r  and  the  term  s  that  plays  the 
role  of  an  extra  control  parameter. 

Under  the  usual  simplifying  assumptions,  the  dynamics  of 
the  wheeled  robot  can  be  written  as 

Dynamics  j  ^  (2) 


where  m  denotes  the  mass  of  the  robot,  /  is  the  moment  of 
inertia  about  the  vertical  body-axis,  and  F  and  N  denote  the 
total  force  and  torque,  respectively.  We  assume  without  loss 
of  generality  that  m  =  I  =  1  in  the  appropriate  units. 

Driving  the  speed  v  to  the  desired  speed  is  trivial  to 
do  with  the  simple  control  law  F  =  v(j  —  k0(v  —  vj), 
which  makes  the  error  v  —  Vd  decay  exponentially  to  zero. 
Controlling  v  is  therefore  decoupled  from  the  control  of  the 
other  variables,  and  all  that  remains  is  to  find  suitable  control 
laws  for  N  and  for  s  to  drive  x,..  ye,  ipe  to  zero,  no  matter 
what  the  evolution  of  v(t)  is. 

Proposition  1  [Path  following].  Let  T  be  a  path  to  be 
followed  by  a  wheeled  robot.  Further  let  the  kinematic  and 
dynamic  equations  of  motion  of  the  robot  be  given  by  (1) 
and  (2),  respectively.  Assume  lim^^  v(t)  ^  0.  Define 


°  =  &(ye)  = 
A(fie,o)  = 
(j)  =  ccs  +  a 


sign(u)  sin  1  k2 
1  if'i/ie  =  c 


sin  ipe—  sin  a 
e—cr 

ki(ipe  -  a) 


otherwise 
-  vyeA(ipe,a) 


for  some  k\  >  0,  0  <  &2  <  1  and  Cq  >  0.  Let  the  control 
laws  for  N  and  s  be  given  by 

N  =  tj>—  fc4(r  -</>)-  (ipe  -  cr)  (3) 

s  =  v  cos  ipe  k^xe  (4) 


for  some  k%,k^  >  0.  Then,  xe,ye,  and  ipe  are  driven 
asymptotically  to  zero  from  any  initial  condition. 

Indication  of  proof.  At  a  purely  kinematic  level,  consider 
the  Lyapunov  function  candidate, 

V  =  \xl  +  \vl  +  ~  o')2  (5) 

which  is  positive  definite  and  radially  unbounded.  With 
r  =  (p  and  s  as  in  (4),  the  time  derivative  of  V  along  the 


trajectories  of  (1)  yields 

V  =  -k3xl  -  ki(ipe  -  cr)2  -  k2\v\- — py -  (6) 

\ye  \  +  £0 

which  is  negative  definite  under  the  given  condition  on  the 
velocity  v.  Standard  back-stepping  technique  can  now  be 
used  to  include  the  dynamics  and  to  show  that  with  the 
control  law  (3)  for  torque  N,  the  states  xe,  ye >  ipe  are  driven 
to  zero.  Notice  that  s  tends  to  v,  that  is,  the  speed  of  the 
virtual  target  approaches  v  asymptotically. 

111.  Coordination 

Equipped  with  the  results  obtained  in  the  previous  section, 
we  now  consider  the  problem  of  coordinated  path  following 
control  that  is  the  main  contribution  of  the  present  paper.  In 
the  most  general  set-up,  one  is  given  a  set  of  n  >  2  wheeled 
robots  and  a  set  of  n  spatial  paths  k  =  1,  2, ...,  n  and  re¬ 
quire  that  robot  k  follow  path  k k .  We  further  require  that  the 
vehicles  move  along  the  paths  in  such  a  way  as  to  maintain  a 
desired  formation  pattern  compatible  with  those  paths.  Figure 
2  shows  the  simple  cases  where  3  vehicles  are  required  to 
follow  straight  paths  or  circumferences  1^;*  =  1,2,3  while 
keeping  a  desired  ’’triangle”  or  ’’in-line”  formation  pattern, 
respectively. 

In  the  simplest  case,  the  paths  1’,  may  be  obtained  as 
simple  parallel  translations  of  a  ’’template”  path  I’*  (Fig.  2, 
right).  A  set  of  paths  can  also  be  obtained  by  considering 
the  case  of  scaled  circumferences  with  a  common  center 
and  different  radii  Ri  (Fig.  2,  left).  In  this  paper,  for 
simplicity  of  presentation,  we  restrict  ourselves  to  ’’in-line” 
formation  patterns  and  to  the  types  of  paths  described  above. 
However,  the  methodology  proposed  for  coordinated  path 
following  can  be  extended  to  deal  with  arbitrary  paths  in 
the  case  of  bidirectional  communication  links  (Ghabcheloo 
et  al. ,  2004c). 

Assuming  that  separate  path  following  controllers  have 
been  implemented  for  each  robot,  it  now  remains  to  coordi¬ 
nate  (that  is,  synchronize)  them  in  time  so  as  to  achieve  a 
desired  formation  pattern.  As  will  become  clear,  this  will  be 
achieved  by  adjusting  the  speeds  of  the  robots  as  functions 
of  the  ”along-path”  distances  among  them.  Consider  for 
example  the  case  of  in-line  formations  maneuvering  along 
parallel  translations  of  straight  lines  as  in  Fig.  3.  For  robot  i, 
let  Si  denote  the  signed  curvilinear  abcissa  of  the  origin  of  the 
corresponding  Serret-Frenet  frame  { T.t }  being  tracked.  Since 
each  vehicle  body-frame  {B;}  tends  asymptotically  to  {T, }, 
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Fig.  3.  Along-path  distances:  straight  lines  and  circumferences 


it  follows  that  the  vehicles  are  (asymptotically)  synchronized 
if  Sij(t)  :=  Si(t)  —  Sj(t)  — >  0 ,t  — y  oo;  *  =  1 
This  shows  that  in  the  case  of  translated  straight  lines  Sjj 
is  a  good  measure  of  the  along-path  distances  among  the 
robots.  Similarly,  in  the  case  of  scaled  circumferences  an 
appropriate  measure  of  the  distances  among  the  robots  is 
Si,j  :=  Si  —  Sj]i  =  1,  „,n,  where  s*  =  Si/Ri.  See  Fig.  3. 

Notice  how  the  definition  of  slt]  relies  on  a  normalization 
of  the  lengths  of  the  circumferences  involved  and  is  equiva¬ 
lent  to  computing  the  angle  between  vectors  U  and  lj  directed 
from  the  center  of  the  circumferences  to  origin  of  the  Serret- 
Frenet  frames  {T,}  and  { T? } ,  respectively.  In  both  cases, 
we  say  that  the  vehicles  are  coordinated  if  the  corresponding 
along  path  distance  is  zero,  that  is,  Si~Sj  =  0  or  Sj—Sj  =  0. 
The  extension  of  these  concepts  to  a  more  general  setting 
requires  that  each  path  F,  be  parameterized  in  terms  of  a 
parameter  £t  that  is  not  necessarily  the  arc  length  along 
the  path.  An  adequate  choice  of  the  parameterization  will 
allow  for  the  conclusion  that  the  vehicles  are  synchronized 
iff  for  all  i,j.  For  example,  in  the  case  of  two  robots 

following  two  circumferences  with  radii  R\  and  Ii>  while 
keeping  an  in-line  formation  pattern,  £*  =  Sj/i?,  ;*  =  1,2. 

In  what  follows,  we  start  by  computing  the  coordination 
error  dynamics,  after  which  a  decentralized  feedback  control 
law  is  derived  to  drive  the  coordination  error  to  zero  asymp¬ 
totically.  In  the  analysis,  the  theory  of  directed  graphs  -  as 
the  mathematical  machinery  par  excellence  to  deal  with  inter¬ 
vehicle  communication  constraints  -  will  play  a  key  role. 


A.  Coordination  error  dynamics 


As  explained  before,  we  let  path  F.t  be  parameterized 
by  £,  and  denote  by  s,  =  Sj(£j)  the  corresponding  arc 
length.  We  further  define  Ri(Ci)  =  ff1  and  assume  Ri(£i) 
is  positive  and  bounded  for  all  The  symbol  is 

motivated  by  the  nomenclature  adopted  for  the  case  of  paths 
that  are  nested  arcs  of  circumferences.  Using  equation  (4), 
it  is  straightforward  to  show  that  the  evolution  of  is  given 
by  ii  =  (vi  cos  rtpel  +  ksiXei)/ which  can  be  written 


as 


& 


1 

Ri(&) 


Vi  +  di 


(7) 


where  di  =  R  ^  ^  (cos  i/tei  —  1  )v,  +  k^iXei.  Notice  from  the 
previous  section  that  di  — >  0  asymptotically  as  t  — >  oo. 
Suppose  one  vehicle,  henceforth  referred  to  as  vehicle  C, 
is  elected  as  a  ’’leader”  and  let  the  corresponding  path 
be  parametrized  by  its  length,  that  is,  £,c  =  sc-  In  this  case, 
Rc{£,c)  =  1.  It  is  important  to  point  out  that  C  can  always  be 


taken  as  a  ’’virtual”  vehicle  that  is  added  to  the  set  of  ’’real” 
vehicles  as  an  expedient  to  simplify  the  coordination  strategy. 
Let  vc  =  vc(t)  be  a  desired  speed  profile  assigned  to  the 
leader  in  advance,  and  known  to  all  the  other  vehicles.  Notice 
now  that  in  the  ideal  steady  situation  where  the  vehicles 
move  along  their  respective  paths  while  keeping  the  desired 
formation,  we  have  c  =  0;  i  =  1, ..,  n.  From  (7),  making 
di  =  0,  it  follows  that  the  desired  velocities  of  vehicles  1  < 
i  <  n  equal  Ri(£,i)v  c{t) .  This  suggests  the  introduction  of 
the  speed-tracking  error  variable 

Vi  =  vi  -  Ri(£i)vc,  1  <i<n  (8) 

Taking  into  account  the  vehicle  dynamics  yields 

fa  =  m  =  Fi  -  {Ri{£i)vc)  ■  (9) 

It  is  also  easy  to  compute  the  dynamics  of  the  origin  of  each 
Serret-Ferret  frame  {T, }  as 

Ci  =  Vi+vc+di  (10) 

To  write  the  above  dynamic  equations  in  vector  form,  define 

V  =  [^7i]nxl?  £  —  [6]nxl»  ^  =  [^i]nxb  ^  =  [^i]nxl  and 

C  =  C(0  =  diag[l /Ri(€i)]nxn  to  obtain 

^  =  u  (11) 

where  1  =  [l]nxi-  Note  that  ||d||  — >  0  asymptotically  as 
t  — >  oo  and  C  is  positive  definite  and  bounded.  Clearly,  the 
objective  is  to  derive  a  control  strategy  for  u  to  make  Ci 
...  =  £n.  This  calls  for  the  definition  of  an  appropriate  error 
space  where  the  problem  of  coordinated  motion  control  can 
be  naturally  formulated.  To  do  this,  it  is  important  to  address 
the  constraints  that  the  inter-vehicle  communication  system 
imposes  on  the  structure  of  the  possible  types  of  control  laws. 

The  general  form  of  feedback  control  law  that  we  consider 
for  each  vehicle  can  be  written  as  Ui  =  u,  ('/;•■!’/  :  j  €  ./;) 
where  Ji  is  the  index  set  that  determines  what  path  parame¬ 
ters  :  j  ^  i  are  transmitted  to  vehicle  i.  With  this  control 
law,  each  vehicle  i  requires  only  access  to  its  own  speed  and 
path  parameter  and  to  some  or  all  of  the  path  parameters 
of  the  remaining  vehicles,  as  defined  by  the  index  set  Jj. 
Clearly,  the  index  sets  capture  the  type  of  communication 
structure  that  is  available  for  vehicle  coordination.  It  is 
thus  natural  that  the  machinery  of  directed  graph  theory 
be  brought  to  bear  on  the  definition  of  the  problem  under 
study.  The  constraints  of  the  problem  at  hand  require  that  we 
consider  directed  graphs  in  order  to  address  the  case  where 
the  communication  channels  among  the  vehicles  include 
unidirectional  links.  At  this  point,  and  before  we  proceed,  we 
recall  some  properties  of  graph  theory  and  matrices,  (Bang- 
Jensen,  2002),  (Godsil  and  Royle,  2001),  and  (Horn,  1985). 

A  directed  graph  or  digraph  Q  =  Q(V,£)  consists  of  a 
finite  set  V  of  vertices  V,:  G  V  and  a  finite  set  £  of  ordered 
pairs  ( Vi,Vj )  €  £,  henceforth  referred  to  as  arcs.  Given  an 
arc  ( Vi,Vj )  €  £,  its  first  and  second  elements  are  called 
the  tail  and  head  of  the  arc,  respectively.  In  the  present 
work,  the  vertices  of  a  graph  represent  vehicles  and  the  arcs 
the  directional  data  links  among  them.  Following  standard 
notation,  the  flow  of  information  in  an  arc  is  always  directed 
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from  its  head  to  its  tail.  The  in-degree  (out-degree)  of  a 
vertex  Vj  is  the  number  of  arcs  with  Vj  as  its  head  (tail). 
If  (Vi,  Vj)  £  £,  then  we  say  that  Vi  and  Vj  are  adjacent. 

A  path  of  length  N  from  V  to  Vj  in  a  digraph  is  a 
sequence  of  N  +  1  distinct  vertices  starting  with  Vj  and 
ending  with  Vj  such  that  consecutive  vertices  are  adjacent. 
If  there  is  a  path  in  Q  from  vertex  Vj  to  vertex  Vj,  then  Vj 
is  said  to  be  reachable  from  Vj.  In  this  case,  there  is  a  path 
of  consecutive  communication  links  directed  from  vehicle  j 
(transmitter)  to  vehicle  i  (receiver).  A  vertex  Vj  is  globally 
reachable  if  it  is  reachable  from  every  other  vertex. 

The  adjacency  matrix  of  a  digraph  Q,  denoted  A ,  is  a 
square  matrix  with  rows  and  columns  indexed  by  the  vertices, 
such  that  the  i,j -entry  of  A  is  1  if  (Vj,Vj)  £  £  and  zero 
otherwise.  The  degree  matrix  I?  of  a  digraph  Q  is  a  diagonal 
matrix  where  the  i,  /'-entry  equals  the  out-degree  of  vertex 
Vj.  The  Laplacian  of  a  digraph  is  defined  as  L  =  D  —  A. 
The  following  Lemma  plays  a  key  role  in  the  development 
that  follows. 

Lemma  (Lin,  2005):  The  Laplacian  matrix  of  a  digraph 
with  at  least  one  globally  reachable  vertex  has  a  simple 
eigenvalue  at  0  with  right  eigenvector  1.  All  the  other 
eigenvalues  have  positive  real  parts. 

From  the  lemma,  if  L  is  the  Laplacian  of  a  digraph  with 
a  globally  reachable  vertex,  then  there  exists  a  nonsingular 
matrix  F,  partitioned  as 

F=(  1  Fi  )’F_1=(  F2  )’  (12> 


Note.  This  paper  tackles  the  case  where  the  matrix  C  = 
C(t;)  =  diag[l/i?i(£;)]  is  constant.  While  restrictive,  it  still 
allows  to  consider  paths  that  consist  of  straight  lines,  nested 
circumferences,  and  parallel  translations  of  one  arbitrary 
path.  The  main  result  on  coordination  control  is  stated  below. 

B.  Coordination  control 

Proposition  2  [Coordination].  Consider  the  coordination 
dynamics  (11)  with  constant  matrix  C.  The  control  law 

u  =  —At]  —  BC~1L^,  (16) 


solves  the  coordination  problem  for  positive  definite  scalar 
matrices  A  =  al  and  B  =  bl  if  the  graph  Q(L)  has  at  least 
one  globally  reachable  vertex  and 


max  ( 

O^yietr(L) 


Im(^i)2 

Re(^i) 


), 


(17) 


where  a(.)  stands  for  the  spectrum  of  a  matrix  and  Inr(.) 
and  Re(.)  denote  the  imaginary  and  real  part  of  a  complex 
number,  respectively.  Furthermore,  the  control  law  (16)  can 
be  written  in  decentralized  form  as 


Ui  =  -arp-  bRidi)  -  L,j).  (18) 

jeJi 


Proof.  To  solve  the  coordination  problem,  consider  for  the 
time  being  the  case  where  d  =  0  (this  assumption  will  be 
lifted  later).  The  unforced  closed-loop  coordination  system 
consisting  of  equations  (15)  and  (16)  can  be  written  as 


such  that 

F-'LF  = 

where  0  =  [0, ...,  0]T  is  a  vector  of  appropriated  dimensions, 
(3  is  a  left  eigenvector  associated  with  the  0  eigenvalue, 
and  in  is  nonsingular  and  has  the  property  that  all  its 
eigenvalues  have  positive  real  parts.  From  the  fact  that 
F~1F  =  In  it  can  be  easily  concluded  that 

F2Fi  =  F2 1  =  0,  (3TF,  =  0 t,L  =  FiLhF2.  (14) 

Define  8  =  F2i j  £  ]Rn_1.  From  (11),  assuming  that 
the  inter-vehicle  communication  network  is  described  by  a 
directed  graph  with  at  least  one  globally  reachable  vertex,  it 
follows  that  the  dynamics  of  (p,  9)  can  be  written  as 

n  =  u  (is) 

8  =  F2Cp  +  F2d.  y  ’ 

Since  F2 1  =  0  and  rank F2  =  n— 1,  then  0  0  f,  =  j, 
for  all  i.j.  Consequently,  if  9  is  driven  to  zero  asymptotically, 
so  are  the  coordination  errors  f,  —  fij  and  the  problem  of 
coordinated  path  following  is  solved. 

Coordination  Problem  formulation.  Consider  the  coor¬ 
dination  system  with  dynamics  (15),  where  d  is  a  bounded 
signal  that  tends  asymptotically  to  zero.  Assume  each  vehicle 
has  access  to  its  own  state  and  exchanges  information  on 
its  path  parameter  £  with  some  or  all  of  the  companion 
vehicles,  as  determined  by  the  constraints  of  the  underlying 
communications  network  ( defined  by  the  Laplacian  matrix  L 
or  index  sets  Ji).  Determine  a  feedback  control  law  for  u 
that  will  drive  9  and  p  asymptotically  to  zero. 


p  =  - Ap  -  BC~1F1Ln9 
9  =  F2Cp. 


We  show  that  the  closed-loop  matrix 


f  -A  -BC-iFiLu 

^  +F2C  0 


(20) 


is  a  stability  (Hurwitz)  matrix.  Using  a  similary  transfor¬ 
mation  diagf/,  CF),  it  can  be  shown  that  A  =  —a  is  an 
eigenvalue  of  Aci  and  the  rest  of  the  eigenvalues  are  given 
by  the  roots  of  det(A(A  +  a)I  +  bLn)  =  0.  Let  p  £  cr(Ln) 
with  Re(/^.)  >  0  be  an  arbitrary  eigenvalue  of  in.  From 
the  last  equation  it  follows  that  p  =  —  A(A  +  a)/b.  Clearly, 
to  every  p  there  correspond  two  possible  eigenvalues  which 
have  negative  real  part  if  a  and  b  satisfy  (17). 

Consider  now  the  situation  where  the  closed  loop  system 
is  driven  by  the  exogenous  signal  d  ^  0.  Since  the  unforced 
system  is  globally  uniformly  exponentially  stable  (GUES), 
the  new  system  is  input-to-state  stable  (ISS).  Furthermore, 
since  d(t)  — >  0  asymptotically  as  t  — >  oo,  so  do  p  and 
9,  thus  completing  the  proof  of  the  theorem.  See  (Sontag, 
1996)  and  (Khalil,  2000)  pp.  174-176  for  details.  Together 
with  the  result  on  path  following  control  in  Section  II,  the 
above  theorem  yields  a  methodology  for  coordinated  path 
following  control  of  multiple  wheeled  robots.  This  statement 
follows  from  the  fact  that,  with  the  control  laws  derived,  the 
conditions  under  which  path  following  is  achieved  are  indeed 
verified.  Namely,  the  velocity  v(t)  of  each  robot  remains 
bounded  and  limt^00ri(f)  f  0  (Ghabcheloo  et  al.,  2004c). 

Remark.  Notice  that  the  eigenvalues  of  the  closed-loop 
coordination  system  are  independent  of  matrix  C.  A  similar 
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result  was  derived  in  (Ghabcheloo  et  al.,  2004a)  for  a 
simple  communication  structure,  using  a  local  linearization 
approach.  The  present  result  is  therefore  a  non-trivial  exten¬ 
sion  of  the  results  in  (Ghabcheloo  el  al,  2004a)  to  a  non¬ 
linear  setting  and  to  more  realistic  communication  structures. 

IV.  Simulations 

This  section  contains  the  results  of  simulations  that  il¬ 
lustrate  the  performance  obtained  with  the  control  laws 
developed.  Figures  4  and  5  correspond  to  a  simulation  where 
3  wheeled  robots  were  required  to  follow  3  circumferences, 
with  radii  2[m],  3[m]  and  4[m],  while  keeping  an  in-line 
formation  pattern.  The  Laplacian  matrix  L  (that  captures 
the  communication  network  among  the  vehicles)  and  the 
coordination  controller  gains  are 

/  !  -!  0\ 

L=\  0  1  -1  and  a  =  2;  6=1,  (21) 

V  "I  0  1  / 

respectively.  The  eigenvalues  of  L  belong  to  the  set 
{0,0.86  ±j 0.5},  thus  verifying  condition  (17).  A  virtual 
leader  vehicle  was  defined  and  its  speed  set  to  a  constant 
value  of  0.1[m/s],  Figure  4  (left)  shows  the  evolution  of  the 
vehicles  as  they  start  from  the  same  point  off  the  assigned 
paths  and  converge  to  the  latter.  Figure  4  (right)  is  a  plot  of 
the  vehicle  speeds  that  ensure  coordination  along  the  paths. 
Finally,  Figure  5  shows  the  coordination  errors  £i  —  £2  and 
Ci  —  £3  and  the  path  following  errors  yei  decaying  to  0. 

V.  Conclusions  and  suggestions  for  further 

RESEARCH 

The  paper  formulated  and  presented  a  solution  to  the 
problem  of  steering  a  fleet  of  wheeled  robots  along  a  set 
of  given  spatial  paths,  while  keeping  a  desired  inter-vehicle 
formation  pattern.  With  the  set-up  adopted,  path  following 
(in  space)  and  inter-vehicle  coordination  (in  time)  are  essen¬ 
tially  decoupled.  Path  following  for  each  vehicle  amounts 
to  reducing  a  conveniently  defined  error  vector  to  zero. 
Vehicle  coordination  is  achieved  by  adjusting  the  speed  of 
each  of  the  vehicles  along  its  path,  according  to  information 
on  the  position  of  the  other  vehicles,  as  determined  by 
the  communications  topology  adopted.  The  methodology 
proposed  led  to  a  decentralized  control  law  whereby  the 
exchange  of  data  among  the  vehicles  is  kept  at  a  minimum 
and  is  channeled  through  communication  links  that  are  not 
necessarily  bidirectional.  Simulations  illustrated  the  efficacy 
of  the  solution  proposed.  Further  work  is  required  to  extend 
the  methodology  proposed  to  air  and  underwater  vehicles. 


Fig.  4.  Coordination  of  3  vehicles.  Left:  Vehicle  paths.  Right:  Speeds. 
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Fig.  5.  Left:  Coordination  errors.  Right:  Path  following  errors. 
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